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Abstract — UUVs  equipped  with  high-level  control  software 
have  a  variety  of  potential  applications  for  Anti-Terrorism/Force 
Protection  (ATFP)  objectives.  Desirable  vehicle  control  capabili¬ 
ties  include  the  ability  to  drive  at  very  low,  controllable  speeds, 
the  ability  to  maintain  a  set  distance  and  attitude  (pitch  and 
roll)  relative  to  some  surface  for  optimal  sensor  (both  sonar  and 
video)  effectiveness,  and  the  ability  for  the  operator  to  intervene 
to  change  the  mission  activities.  Moreover,  a  vehicle  capable 
of  rotating  in  place  or  having  a  fraction  of  a  meter  turning 
radius  is  needed  to  conduct  the  mission.  The  present  state-of-art 
vehicles  are  not  maneuverable  enough  to  successfully  accomplish 
most  of  these  tasks.  The  novel  controllers  are  expected  to  be 
nonlinear  due  to  the  fact  that  the  vehicle  is  translating  at  nonzero 
attitude  or  translating  in  a  direction  different  from  that  of  the 
surface.  Non-linear  controller  that  compensates  for  non-linear 
forces  (such  as  drag,  buoyancy/gravity)  was  designed,  installed 
onto  the  UUV  test-bed,  and  in-water  tested.  The  structure  of  a 
controller  is  hierarchical  such  that  an  ’’inner  loop”  non-linear 
controller  (outputs  the  appropriate  thrust  values)  is  the  same 
for  all  mission  scenarios  while  an  appropriate  ’’outer-loop”  non¬ 
linear  controller  is  used  based  on  what  mission  or  part  of  the 
mission  is  desired. 

I.  Introduction 

An  increasing  variety  of  sensors  are  becoming  available 
for  use  onboard  autonomous  vehicles.  Given  these  enhanced 
sensing  capabilities,  scientific  and  military  personnel  are  in¬ 
terested  in  exploiting  autonomous  vehicles  for  increasingly 
complex  missions.  Most  of  these  missions  require  the  vehicle 
to  function  in  complex,  cluttered  environments  and  react  to 
changing  environmental  parameters.  This  paper  presents  the 
control  design,  simulation  results,  and  initial  in-water  results 
of  several  complex  mission  scenarios.  One  of  the  primary 
mission,  for  which  the  novel  controller  was  used,  was  a 
mission  where  the  vehicle  was  using  the  data  from  onboard 
sonar  Acoustic  Doppler  Current  Profiler  (ADCP)  sensor  in 
order  to  accurately  follow  a  curved  surface  below  it.  The 
sonar  outputs  four  beams  which  measure  the  distance  from  the 


vehicle  to  the  bottom,  as  well  as,  the  relative  vehicle  attitude  to 
the  bottom.  The  vehicle  was  tested  following  the  bottom  of  the 
300  ft  by  200  ft  by  38  ft  deep  Transducer  Evaluation  Center 
(TRANSDEC)  pool  at  SPAWAR  Systems  Center  San  Diego 
(SSC-SD).  The  pool  is  bowl  shaped  so  its  depth  is  increasing 
toward  the  center  of  it.  The  vehicle’s  task  was  to  intelligently 
maintain  the  desired  stand-off  distance  from  the  curved  bottom 
by  adjusting  its  pitch  and  roll  based  on  the  information  coming 
from  the  sonar  sensor.  Another  task  for  the  vehicle  was  to 
track  a  line  along  the  desired  path  while  maintaining  the 
desired  distance  (altitude)  from  the  bottom.  The  vehicle  used 
the  novel  translational,  attitude,  and  altitude  controller  based 
on  the  nonlinear  control  technique  called  Backstepping.  The 
novel  controller  implements  the  ideas  of  Backstepping  and,  in 
addition,  introduces  a  new  algorithm  called  Command  Filtered 
(CF)  Backstepping. 

In  this  paper,  we  also  present  the  novel  vehicle  simulator 
which  simulates  both  the  navigation  and  control  systems  of 
the  vehicle.  The  simulator  is  in  the  form  of  open-architecture 
which  allows  other,  additional  controllers  to  be  easily  added. 
This  simulator  can  simulate  any  mission  from  start  to  end 
allowing  the  operator  the  chance  to  check,  review,  and  possibly 
change  the  mission  plan  prior  to  loading  the  mission  onto  the 
UUV.  In  essence,  it  gives  the  operator  the  assurance  that  the 
mission  will  result  in  a  success.  The  actual  in-water  results 
very  closely  resembled  the  simulated  mission  for  all  control 
modes  tested.  This  paper  stresses  the  comparison  between  the 
simulated  and  actual  in-water  mission  performed  by  the  UUV. 

Several  places  in  this  paper  refer  to  filtering  of  a  signal  x°c  to 
produce  a  signal  xc  and  its  derivative  xc.  This  is  referred  to 
as  command  filtering.  The  motivation  of  command  filtering 
is  to  determine  the  signals  xc(t)  and  xc(t)  as  needed  for 
the  next  iteration  of  the  backstepping  procedure  [7],  without 
having  to  analytically  differentiate  x°,  because  the  analytic 
differentiation  becomes  overly  cumbersome  for  systems  of 
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high  dimension.  The  effects  of  command  filtering  on  the 
backstepping  stability  analysis  are  analyzed  in  [4],  [5],  [6] 
and  will  not  be  repeated  herein.  The  summary  of  that  analysis 
is  that  for  a  properly  designed  command  filter  (unity  DC  gain 
to  the  first  output  and  the  second  output  being  the  derivative  of 
the  first  output)  the  system  will  be  stable  and  the  tracking  error 
will  be  O  where  lob  is  the  bandwidth  of  the  command 

filter.  Therefore,  the  tracking  error  can  be  made  arbitrarily 
small  by  increasing  the  parameter  u>b- 

The  paper  is  organized  as  follows.  Section  II  describes  the 
developed  vehicle  simulator  and  overall  vehicle  navigation  and 
control  structure.  Section  III  defines  a  thruster  powered  UUV 
kinematics  and  dynamics  equations.  Section  IV  outlines  the 
control  law  signals  that  need  to  be  implemented  for  trajectory 
tracking  and  attitude  control.  Sections  V,  VI,  and  VII  present 
a  detailed  derivation  of  trajectory  tracking  control  laws  to  deal 
with  vehicle  kinematics  and  dynamics.  The  performance  of  the 
control  system  proposed  is  illustrated  in  simulation  in  Section 
VIII  and  in  real  in-water  tests  in  Section  IX.  Finally,  Section 
X  contains  the  conclusions  and  describes  some  problems  that 
warrant  further  research. 

II.  Vehicle  Simulator  and  Overall  Architecture 

During  this  research  effort  we  leveraged  the  existing  vehicle 
sensors  and  improved  their  use  by  introducing  novel  control 
and  navigation  techniques.  Vehicle  dynamics,  its  sensors,  and 
the  environmental  factors,  such  as  currents,  are  modeled  in  a 
comprehensive  vehicle  simulation  described  in  Figure  1.  Our 
software  simulates  sensor  noise  and  performance  character¬ 
istics,  range  measurements,  acoustic  angle  of  incidence  and 
line-of-sight  requirements,  and  random  drop  outs.  Simulation 
environment  can  import  3D  models  of  arbitrary  solid  objects, 
such  as  ship  hulls,  sea  floor  terrain  maps,  quay  walls,  pier 
pilings,  etc.  The  same  vehicle  and  control  software  that  is 
executed  in  simulation  is  executed  onboard  of  the  UUV.  This 
approach  significantly  reduces  costly  in-water  testing  require¬ 
ments  as  well  as  provides  mission  plan  verification.  This 
approach  accelerates  vehicle  navigation,  control,  and  mission 
development  since  we  can  experiment  with  operational  chal¬ 
lenges  without  asset  risk.  Moreover,  the  simulator  can  be  used 
as  a  great  operator  training  tool  through  basic  operator  tele¬ 
operation  training.  UUVs  equipped  with  this  type  of  software 
can  greatly  enhance  current  underwater  security  capabilities, 
relieving  divers  of  time-consuming,  dangerous  tasks,  therefore, 
reducing  manpower  and  mission  timeline  requirements. 

The  overall  vehicle  navigation  and  control  architecture  is 
described  in  in  Figure  2.  Vehicle  sensors,  such  as  Inertial  Mea¬ 
surement  Unit  (IMU),  Doppler  Velocity  Log  (DVL),  Long- 
Baseline  (LBL),  compass,  pressure,  and  altimeters,  provide 
noisy  measurements  of  the  vehicle’s  movements.  Navigation 
estimates  the  vehicle’s  true  state  (position,  attitude,  velocity, 
and  angular  rates).  A  Kalman  filtering  algorithm  is  imple¬ 
mented  for  vehicle  navigation.  The  navigation  software  is 
such  that,  the  fast  rate  sensor  IMU  is  aided  with  slower  rate 
DVL  and  LBL  sensors  in  order  to  accurately  navigate  in  the 
harsh  environment,  for  example,  under  the  hull  of  a  ship  in 


Fig.  1.  Comprehensive  Vehicle  Simulation 


the  harbor.  Adaptive  Mission  Planner  (AMP)  manipulates  the 
mission  plan  in  order  to  optimally  obtain  a  mission  goal. 
Mission  Spooler  executes  a  series  of  behavioral  commands 
dictated  by  the  AMP.  The  hydro-forces  acting  on  the  vehicle 
are  modeled  and  their  effect  is  accounted  for  with  the  advanced 
nonlinear  control  technique.  The  expected  model  uncertainties 
are  compensated  for  using  a  novel  approach  to  backstepping 
nonlinear  control  technique.  Great  tracking  of  the  desired  tra¬ 
jectory  is  achieved.  The  structure  of  a  controller  is  hierarchical 
such  that  an  ’’inner  loop”  non-linear  controller  (outputs  the 
appropriate  thrust  values)  is  the  same  for  all  mission  scenarios 
while  an  appropriate  ’’outer  loop”  nonlinear  controller  is  used 
based  on  what  mission  or  part  of  the  mission  is  desired.  Inner 
loop  controller  computes  the  desired  thrust  values  to  achieve 
the  commanded  velocities  and  angular  rates  and  sends  the 
commands  to  thrusters  which  create  vehicle  movement.  Outer 
loop  controller  computes  the  desired  velocities  and  angular 
rates  to  achieve  a  behavior. 

Using  the  described  vehicle  architecture  structure  and  the 
approach  of  testing  the  entire  vehicle  mission  in  simulation 
prior  to  performing  the  actual  in-water  test  we  achieved  great 
results  at  the  recent  Autonomous  Underwater  Vehicle  Festival 
(AUVFest),  June  6-15  2007,  held  in  Panama  City.  The  vehicle 
employed  for  simulation  and  in-water  testing  is  underactuated 
since  the  lateral  speed  v  is  not  directly  affected  by  the  thrusters 
(no  side  thrusters),  which  makes  certain  desired  maneuvers 
more  difficult  to  achieve.  During  AUV  Fest,  we  accomplished 
12  hours  of  in-water  demonstration  time.  All  hull  search  ve¬ 
hicle  behaviors  were  demonstrated  with  the  following  unique 
capabilities:  autonomous  mission  execution  with  intervention 
capability,  hull  search  conducted  using  side  look  sonar,  sensors 
parameters  optimized  by  operator  during  mission,  real-time 
topside  display  of  Sound  Metrics  DIDSON  High  Definition 
Imaging  Sonar  and  Marine  Sonics  1800kHz  Side  Looking 
Sonar,  vehicle  position  and  status  information  embedded  in 
DIDSON  sensor  data  and  Joint  Architecture  for  Unmanned 
Systems  (JAUS)  communication  protocol  implemented  on 
UUV. 


Fig.  2.  Navigation  and  Control  Architecture 


III.  THRUSTER  POWERED  AUV  DYNAMICS 
Let  the  vehicle  dynamics  be  described  as  [2] 

P  =  R\vb  (1) 

0  =  VLoj  (2) 

vb  =  M-\Ul-Fnlin)  (3) 

v  =  J~1(u2~MnHn)  (4) 

where  p  =  [a; .  y.  d]  is  the  earth  relative  position,  Ilfh  is  the 
rotation  from  body  to  earth  frame,  vb  =  [it,  t;,w]T  is  the 
velocity  in  body  frame,  0  =  [</>,  0 ,  ip)  is  the  attitude,  Q  is 
a  nonlinear  (nonsingular  except  at  0  =  matrix  function 
of  0,  oj  is  the  inertial  rotation  rate  vector  represented  in 
body  frame,  Fnun  represents  the  body-frame  nonlinear  forces, 
Mniin  represents  the  body-frame  nonlinear  moments,  iti  is  the 
vector  of  control  forces,  it2  is  the  vector  of  control  moments. 
The  control  forces  and  moments  are  generated  by  a  set  of  five 
thrusters  mounted  to  achieve  full  angular  rate  control  (i.e., 
u>),  surge  control  (i.e.,  it),  and  heave  control  (i.e.,  w).  The 
vector  T  =  [Ti, ... ,  1  of  five  thrusts  is  related  to  the  the 

control  forces  and  moments  by  a  known  thrust  distribution 
matrix  such  that  u\  =  LfT  and  u2  =  LmT  where  Lf  £  3?2x5 
and  Lm  £  3?3x5.  The  AUV  is  underactauted  since  the  lateral 
speed  v  is  not  directly  affected  by  the  thrusters. 

The  rotation  matrix,  is  defined  as 


Rl 


c9cip  cips9s<p  ~  c< psip  c<pcips9  +  s<psip 

c8sip  cpcip  +  s9s<psip  —cipscp  +  ccpsPsip  , 
— s  9  c9s(p  c9ccf) 


and  the  angular  rate  transformation  matrix,  O,  as 


ft  = 


1  s<pt9  ccpt  9 
0  c  cp  — s  (j> 

0  scp/c  9  ccj)/c9 


where  the  symbols  c2,  sz,  and  tz  represent  cos(z),  sin(z),  and 
tan(z). 


IV.  CONTROL  SIGNALS  IMPLEMENTATION 

This  section  summarizes  the  control  law.  The  stability 
analysis  is  rigorously  analyzed  in  [3]  as  well  as  in  the  journal 
paper  that  the  authors  are  working  on  [1].  Due  to  lack  of 


space,  the  arguments  are  not  repeated  herein.  The  following 
equations  represent  the  control  signals 

o  II  [  Fx  FxyX  T  Xc,  Fy  FxyV  T  Vc\  \ 

Uc  ~  7  d) 

ipc  —  citOji ifl  ['■y  (  Fy  KXyy  T  ?/c) ,  '■y  (  F ^  KXyX  T  ^c)] 

0  u  sin (6)  —  cos (0)  sin (<j))v  —  K^d  +  dc 

W°  cos (9)  cos (</>) 

=  O  1  (-KeQ  +  0c  ~  0bs^ 

111  =  M (Fnlin  KvVb  Vbc 

u2  =  J ( Mnlin  F-U&  F  ^ c  Mbs)  i 


where  7  =  ±1  and  i/jbs,  ubs,  ic;,s,and  u>bs  are  debited  in  eqns. 
9,  8,  13,  and  16,  respectively.  Because  in  this  article,  the  9 
and  4>  commands  are  externally  generated,  while  ip  is  used 
as  a  control  variable,  only  yaw  backstepping  term,  ipbs,  must 
be  debned  for  implementation  of  oj°  signal,  which  is  done  in 
Section  V.  The  terms  9bs  and  <pbs  are  identically  zero.  The  term 
vbbs  is  the  vector  notation  of  ubs  and  wbs  terms  while  ujbs  is 
the  vector  notation  of  pbs,  qbs,  rbs  terms.  For  7  =  1  the  vehicle 
drives  forward  while  for  7  =  — 1  the  vehicle  drives  backward. 
Also,  because  this  is  trajectory  following,  it  is  assumed  that  the 
speed  ||(i;c,yc)||  is  non-zero  and  we  have  selected  a  solution 
for  which  the  AUV  forward  velocity  is  always  positive. 


V.  Trajectory  Following 


The  inputs  to  this  control  loop  are  xc(t),  yc{t),  and  the 
derivatives,  xc,  yc.  We  assume  that 


xc 

Vc 


>  e  >  0 


This  section  is  concerned  with  the  control  of  [2,  y]  by  speci- 
bcation  of  desired  values  for  [u,ip\. 


A.  Kinematic  Analysis 

Since  v  is  not  controllable  and  w  is  used  to  control  depth 
we  will  control  x  and  y  by  calculating  appropriate  Ud  and  ipd 
signals.  For  clarity,  we  rewrite  x  and  y  dynamics  as 


where 


x 

y 


ux 

ILy 


c9  + 


Fx 
Fv  . 


Fx  =  [cipsdsp  —  cpsip]v  +  [c(pcips9  +  scpsip]w, 
Fy  =  [cpcip  +  s9s(psip]v  +  [—cipsp  +  C(ps9sip]w, 


and 

ux  =  u  cip 

Uy  =  U  Sip. 

The  dynamic  equation  for  x  and  y  can  be  manipulated  as 
follows 


x 

y 


Fx 

Fy 


Ux 

uZ 


c  9  + 


ux 

Uy 


c.e 


where  ux  =  ux  —  uXc  and  uy  =  uy  —  uVc.  Again,  there  is 
another  term,  [uXo  —  it°c,  uyc  —  u°a\T ,  that  should  be  accounted 
for  in  the  analysis,  where  uXc  =  uccipc,  u°c  =  uCocip°,  etc. 


This  term  can  be  made  arbitrarily  small  by  increasing  the 
bandwidth  of  the  command  filter  that  is  used  to  compute  uc 
and  tpc  (and  their  derivatives)  from  u°c  and  ip°.  The  effect 
of  this  term  is  rigorously  analyzed  in  [3].  Due  to  lack  of 
space,  the  arguments  are  not  repeated  herein.  We  select  signals 


,o  IT 


■u° 

cos(6 1)  (  Fx  BxyX  +  XC) 

[  K.  \ 

cos {6)  (  KxyV  +  Vc) 

(6) 


where  Kxy  is  time  varying  and  positive.  The  selection  of  the 
control  signal  above  yields  the  x  and  y  position  error  dynamic 
equations : 


y 


KXy^ 

KxyV 


Vx 

Uv 


c  9 


(7) 


Two  questions  remain:  how  should  we  manipulate  the 
ux  and  uy  terms  to  allow  a  rigorous  stability  analysis  that 
accounts  for  them;  and,  how  should  u°  and  ip°  be  specified  to 
achieve  [u°c,  These  issues  are  addressed  in  the  following 
subsections. 

Simplification  of  ux  and  uy.  These  terms  can  be  manipulated 
by  two  very  similar  approaches  (derived  in  [1]).  In  either  case 


where  we  constrain  the  commanded  value  of  9  such  that 
9  ^  Also,  because  this  is  trajectory  following,  it  is  assumed 
that  the  speed  ||(i:c,yc)||  is  non-zero  and  we  have  selected 
a  solution  for  which  the  AUV  forward  velocity  is  always 
positive. 

Eqn.  (6)  has  the  form. 


u°  ci>° 

U°  S 


-  Vd  KXyE 


where 


the 

1  1 

Si  Si 

term  can  be  expressed  in  the  following  form 

vd  = 

cos(e)  (  Fx  +  xc) 
COS (9)  (  Fy  +  yd) 

and  E  = 

cos(fl)  (*) 
cos(0) 

=Au  +  Bg$)i,. 

Uy  _ 

Thus,  the  position  error  dynamics  can  be  expressed  as 


X 

KXyX 

.  v  . 

ExyV 

(Au  +  Bg(dp)dp)  cos(0) 


which  is  a  form  suitable  for  stability  analysis.  The  first  term 
will  be  accommodated  by  the  u  backstepping  control.  The 
second  term  will  be  accommodated  by  the  ip  backstepping 
control.  Selecting  Approach  1  in  [1],  we  define  ubs  and  ipbs 
backstepping  terms  as 


and 

4>bS 


uba  =  c  9(cipcx  +  sipcy) 


(8) 


c  9  ■ 


.  cos (ip)  —  1  ,  sin(U) 

U  C1pc - = - u  sipc — = — 

dp  dp 

,  cos  (ib)  —  1  ,  sin(T>) 

U  S1pc - = - b  U  Clpc - = - 

Ip  Ip 


X  (9) 


The  quantity  Vd  is  the  velocity  vector  that  would  cause  the 
vehicle  to  follow  the  trajectory  given  that  the  vehicle  was 
currently  on  the  trajectory.  The  quantity  KxyE  is  the  feedback 
term  that  would  cause  the  vehicle  to  converge  toward  the 
trajectory. 

For  the  stability  analysis  to  follow,  the  value  of  Kxy  must  be 
positive;  however,  its  magnitude  must  be  selected  with  care. 
Consider  the  situation  depicted  in  Figure  3  where  the  inner 
product  of  Vd  and  E  is  positive  (i.e.,  the  AUV  is  ahead  of  the 
current  desired  trajectory  position).  Since  the  speed  cannot  be 
negative,  depending  on  the  value  of  Kxy ,  the  commanded  yaw 
angle  could  result  in  the  vehicle  circling  to  get  to  the  desired 
location.  In  particular,  when  A'a;j/||.E||  >  ||ud||,  the  vehicle  may 
be  commanded  in  a  direction  opposite  to  the  desired  direction 
of  the  trajectory. 

To  prevent  this  we  must  ensure  that  the  angle  between  Vd 
and  Vd  —  KxyE  is  less  than  90  deg: 

{vy,  (vd  -  KxVE))  >  0  (10) 

\\vdf  >  Kxy(vd,  E).  (11) 


B.  Selection  of  Control  Gain 

This  subsection  discusses  technical  details  related  to  the 
selection  of  Kxy  in  eqn.  (6). 

A  solution  to  eqn.  (6)  for  uc  and  tpc  is 

o _  ||  [  Exyx  -b  xC:  Fy  Kxyy  -b  yd  || 

Uc~  ^  ' 

and 


Ipc  atari 2  (  Fy  Exyy  -b  yet  Bx  Kxyx  -b  xfj 


There  are  three  possible  cases: 

1)  (vd,E)  >  0  :  This  is  the  problematic  case  that  could 
result  in  the  vehicle  pointing  opposite  to  the  desired 
velocity  if  Kxy  is  too  big.  The  value  of  Kxy  should 
be  selected  such  that 


K  <  llmll 

xv~  ( vd,E y 


2)  ( Vd,E )  =  0  :  In  this  case,  the  value  of  I\xy  does  not 
matter. 


3)  (vd,  E)  <  0  :  In  this  case,  any  positive  value  of  Kxy 
satisfies  eqn.  (11). 

Therefore,  the  designer  specifies  positive  constants  k  and  0  < 
a  <  1.  At  each  time  instant, 

k  if  (vd,  E)  <  0 

min  (Z&  ’*0  if  ^ Vd ’  E)  >  °- 

In  situations  such  as  that  in  Figure  3,  this  approach  results  in 
the  vehicle  driving  towards  the  trajectory  with  the  tangential 
component  small  enough  that  the  trajectory  point  will  ulti¬ 
mately  catch  up  to  the  AUV.  In  the  case  where  the  vehicle 
is  on  the  trajectory  directly  in  front  of  the  desired  location, 
this  choice  approach  causes  the  vehicle  to  drive  slower  than 
the  desired  point  is  moving,  in  effect  waiting  for  the  desired 
location  to  catch  up. 


where  Kq  is  a  positive  definite  matrix  and  0(f)  =  0(f)  — 
(-)c(t).  Using  this  definition,  the  closed-loop  tracking  error 
corresponding  to  eqn.  (2)  is 

0  =  fiw"  +  n(tu  —  loc)  +  n(u)c  —  u>°)  (14) 

=  — A©0  T  0C  T  flu)  —  06s 

0  =  -KeQ  +  flw  -  06s  (15) 

where  the  term  Q(u>c  -w°)  is  dropped  after  eqn.  (14).  This 
term  can  be  made  arbitrarily  small  by  increasing  the  bandwidth 
of  the  command  filter  that  is  used  to  compute  u)c  and  uc 
from  ui°.  The  effect  of  this  term  is  rigorously  analyzed  in  [3]. 
Due  to  lack  of  space,  the  arguments  are  not  repeated  herein. 
To  compensate  for  the  sign  indefinite  u)  term  in  the  stability 
analysis  the  term  Ubs  in  Section  VII  is  defined  as 

W6s  =  flT0.  (16) 


C.  Mode:  D  Translation 

The  objective  of  this  component  of  the  outer  loop  is  to  select 
w°(t)  to  force  d(t)  to  converge  to  dc(t),  where  dc(t)  and  dc(t) 
are  known  command  signals. 

Using  the  last  row  of  the  R  matrix,  the  dynamics  of  d  are 

d  =  —usin(6)  +  cos(d)  sm((j>)v  +  cos(6l)  cos {4>)w. 

Since  desired  values  for  u,  4>,  and  6  are  already  specified  and 
v  is  not  controllable,  assuming  that  9  ^  90°  and  <fi  ^  90°,  we 
will  select  the  commanded  value  of 

0  usin(9)  —  cos (9)  sin((/>)t>  —  Kdd  +  dc 
W°  cos (0)  cos ((/>) 

for  w  to  control  d.  This  yields  the  closed  loop  depth  error 
dynamic  equation 

d  =  —  Kdd  +  c9c(j)w  +  c9c<j)(wc  —  w°)  (12) 

where  the  last  term  is  dropped  in  the  subsequent  analysis 
due  to  space  limitations,  but  can  be  analyzed  rigorously  by 
methods  similar  to  those  in  [3]. 

Following  the  approach  described  in  [1]  we  can  define  the 
backstepping  term 

Wbs  =  c9ccj)d  (13) 

that  will  be  incorporated  into  the  w  inner  loop  control  signal 
to  cancel  the  sign  indefinite  portion  in  the  stability  analysis. 

VI.  MIDDLE  LOOP  -  ATTITUDE  CONTROL 

This  control  loop  will  be  used  by  each  of  the  outer 
loops  and  therefore  it  is  described  separately.  The  inputs  to 
this  outer  loop  are  roll,  pitch,  and  yaw  commands,  0C  = 
[(/>c(f),  9c(t),  V’c(f)]  and  the  derivatives  of  these  signals,  which 
are  produced  by  command  filtering.  Additional  inputs  are  the 
roll,  pitch,  and  yaw  backstepping  terms,  Qbs- 

For  attitude  control,  based  on  eqn.  (2),  we  define  the  signal 

u>°  =  fl-1  A©0  +  0C  —  Qbs'j 


VII.  INNER  LOOP 

The  inputs  to  the  inner  loop  are  uc,  uc,  wc,  wc,  uic,  loc,  Ubs, 
u>6s,and  uibs-  Each  of  these  input  signals  is  defined  by  one  of 
the  middle  or  outer  loops  as  will  be  described  in  the  sequel. 
Each  of  the  signals  uc,  wc,  and  u)c  are  commands  to  the  inner 
loop.  The  signals  iic,  wc,  and  uc  are  the  derivatives  of  the 
commands.  The  signals  are  Ubs,  u>bs  and  w/,s  are  backstepping 
terms  defined  to  cancel  sign-indefinite  terms  in  the  stability 
analysis. 

The  inner  loop  control  signals  are 

Ui  ~  M (Fnlin  Ey^b  T  t?6c  t^66s)  (17) 

V>2  —  d (ATnljn  EuiO  T  tUc  Ulbs)  (18) 

with  the  thrust  vector  defined  as 


'  Lf  - 

-1 

Ui 

Lm 

.  112 

where  Vb  =  Vb  —  Vbc,  u)  =  lo  —  loc,  and  Kv  and  Ku  are  positive 
definite  matrices. 

With  this  choice  of  the  control  signal  and  the  fact  that  Vb  — 
i>b  —  i>bc  and  u)  =  Co  —  u>c,  the  dynamics  of  the  tracking  errors 
are 


U  = 

~ KUU  - 

^hs 

w  — 

—Kww 

~  Wbs 

Co  — 

-K^Co 

Wbs 

VIII.  Simulation  Results 

Figures  4-8  present  the  results  from  about  300  seconds 
of  a  simulated  mission,  during  which  the  vehicle  navigates 
around  a  box  defined  by  the  following  four  (N,E)  corners: 
(0,-20),  (10,-20),  (10,-10),  and  (0,-10).  The  vehicle  traverses 
the  trajectory  connecting  the  box  corners.  The  2D  position 
plot  is  shown  in  Figure  4.  The  great  trajectory  repeatability 
and  tracking  of  the  desired  path  is  observable.  The  transition 
at  the  corners  can  be  improved  by  adding  another  controller 
which  will  command  zero  speed  when  the  vehicle  reaches 
each  corner.  In  that  situation,  the  vehicle  would  yaw  to  the 
appropriate  angle  and  then  resume  its  path.  The  position  plot 


showing  north,  east,  down,  and  altitude  position  versus  time  is 
shown  in  Figure  5,  while  the  attitude  (roll,  pitch,  yaw)  plot  is 
shown  in  Figure  6.  Vehicle’s  horizontal  and  vertical  velocities 
are  shown  Figure  7,  while  the  angular  rates  (roll,  pitch,  yaw 
rate)  plot  is  shown  in  Figure  8.  The  vehicle  is  maneuvering 
in  three  dimensions,  as  the  actual  depth  is  distinct  for  each 
edge  of  the  box  (see  plot  three  in  Figure  5).  The  vehicle 
is  programmed  to  maintain  the  altitude  from  the  bottom  as 
opposed  to  depth.  Excellent  tracking  performance  can  be 
observed  since  the  actual  vehicle  states  (blue  lines)  converge  to 
the  desired  ones  (black  and  red  lines).  In  addition  to  navigating 
to  the  four  desired  corners,  the  vehicle  is  conforming  to  the 
bowl  shape  of  the  TRANSDEC  pool  (a  model  of  the  pool  is 
imported  in  the  simulator).  The  vehicle  is  adjusting  its  pitch 
going  up  and  down  the  pool  and  its  adjusting  its  roll  when 
going  along  the  side  of  the  bowl  (see  plot  one  and  two  in 
Figure  6).  The  desired  distance  from  the  bottom  (altitude)  is 
maintained  within  of  ±0.05  m  of  the  desired  altitude  of  1.5 
m  as  shown  in  the  fourth  plot  in  Figure  5. 

IX.  TRANSDEC  Testing  Results 

Figures  9-13  present  the  results  of  a  similar  in  length 
portion  of  an  actual  in-water  mission,  during  which  the  vehicle 
navigates  around  a  box  in  the  TRANSDEC  pool.  This  mission 
had  the  same  requirements  as  the  mission  that  was  run  by  the 
simulator.  The  results  also  very  closely  resemble  the  simulated 
results  which  validates  our  approach.  Again,  the  2D  position 
plot  shown  in  Figure  9.  The  position  plot  showing  north,  east, 
and  down  position  versus  time  is  shown  in  Figure  10,  while 
the  attitude  (roll,  pitch,  yaw)  plot  is  shown  in  Figure  11. 
Vehicle’s  horizontal  and  vertical  velocities  are  shown  Figure 
12,  while  the  angular  rates  (roll,  pitch,  yaw  rate)  plot  is  shown 
in  Figure  13.  The  vehicle  is  maneuvering  in  three  dimensions, 
as  the  actual  depth  is  distinct  for  each  edge  of  the  box. 
Great  trajectory  tracking  performance  can  be  noticed  since  the 
vehicle  well  maintained  its  track-line.  It  is  worth  to  mention 
that  this  is  greatly  desired  capability,  an  example  being  ship- 
hull  inspection  mission,  since  100  percent  ship-hull  coverage 
is  required.  Excellent  tracking  performance  can  be  observed, 
for  instance,  maximum  altitude  variations  were  around  ±0.2 
m;  the  vehicle,  as  it  was  supposed  changed  its  roll  and  pitch 
in  order  to  accomplish  the  mission  goal  of  translating  while 
maintaining  1.5  m  distance  from  the  TRANSDEC  bowl. 

X.  Conclusion 

This  paper  has  discussed  the  design  and  derivation  of 
a  command  filtered,  vector  backstepping  approach  to  de¬ 
sign  a  stable  translational  and  attitude  controller  (i.e.,  y  = 
[x(t) ,  y(t) ,  d( i),il>(t),6(t)]T)  applicable  to  an  underactuated 
UUV.  The  mission  scenario  specifies  the  position  and  attitude 
commands  which  are  command  filtered  to  produce  inputs 
(together  with  their  derivatives)  for  the  outer  loop  and  middle 
loop  controllers.  The  commands,  such  as  horizontal  and  verti¬ 
cal  velocities  (uc,wc)  and  angular  rates  (pc,gc,rc)  are  generated 
by  the  outer  and  middle  loop,  command  filtered,  and  are  inputs 
(together  with  their  derivatives)  to  the  velocity  and  angular 
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Fig.  4.  2D  Position  vs.  Time:  Blue  line  is  the  actual  vehicle  trajectory,  black 
line  is  the  command,  and  the  red  line  is  filtered  command 


Fig.  5.  North,  East,  Down,  and  Altitude  Position  vs.  Time:  Blue  line  is  the 
actual  vehicle  trajectory,  black  line  is  the  command,  and  the  red  line  is  filtered 
command 

rate  inner  loop  controllers.  The  inner  loop  determines  the 
appropriates  thrust  forces.  The  article  has  presented  both  the 
control  law  derivation,  the  simulation  results,  and  the  actual  in¬ 
water  results.  The  actual  in-water  results  very  closely  resemble 
the  simulated  mission  for  all  control  modes  tested.  This  paper 
stresses  the  comparison  between  the  simulated  and  actual  in¬ 
water  mission  performed  by  the  UUV  and  advocates  the  use 
of  great  simulation  tool  that  was  developed. 

The  plan  for  future  is  to  design  additional  outer  loop  con¬ 
trollers  to  increase  the  vehicle  maneuverability  and  capability. 
The  outer  loop  controllers  are  defined  for  different  vectors 
of  outer  loop  control  variables  as  specified  by  the  vector  of 
outputs  y. 
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Fig.  6.  Attitude  vs.  Time:  Blue  line  is  the  actual  vehicle  attitude,  black  line 
is  the  command,  and  the  red  line  is  filtered  command 
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Fig.  8.  Angular  Rates  vs.  Time:  Blue  line  is  the  actual  vehicle  angular  rate, 
black  line  is  the  command,  and  the  red  line  is  filtered  command 
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Fig.  7.  Velocities  vs.  Time:  Blue  line  is  the  actual  vehicle  velocity,  black  Fig-  9.  2  D  Position  vs.  Time:  Blue  line  is  the  actual  vehicle  trajectory,  black 
line  is  the  command,  and  the  red  line  is  filtered  command  line  is  the  command,  and  the  red  line  is  filtered  command 
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Fig.  10.  North,  East,  Down,  and  Altitude  Position  vs.  Time:  Blue  line  is  pig.  12.  Velocities  vs.  Time:  Blue  line  is  the  actual  vehicle  velocity,  black 

the  actual  vehicle  trajectory,  black  line  is  the  command,  and  the  red  line  is  line  is  the  command,  and  the  red  line  is  filtered  command 

filtered  command 
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Fig.  11.  Attitude  vs.  Time:  Blue  line  is  the  actual  vehicle  attitude,  black  line 
is  the  command,  and  the  red  line  is  filtered  command 


Fig.  13.  Angular  Rates  vs.  Time:  Blue  line  is  the  actual  vehicle  angular  rate, 
black  line  is  the  command,  and  the  red  line  is  filtered  command 


